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Abstract 

Many efforts are underway to extend the abilities of robots into the domain of space, 
where they can be used to perform simple tasks in environments where it is difficult or 
dangerous for humans to work. One such effort, the Flight Telerobotic Servicer (FTS) is 
being undertaken for NAS A by Martin Marietta. 

The FTS is a two arm manipulator system mounted on a mobile platform. A third 
arm is used to anchor the platform while working. The two manipulators on the FTS are 
seven degree of freedom arms which will be used to perform a variety of tasks. MIT was 
contracted, in conjunction with the University of Iowa, to build an accurate simulation of a 
seven degree of freedom manipulator similar to that proposed for the FTS. This thesis 
documents the development of that model. 

In order to perform some tasks, the FTS will need some sort of force control ability. 
To assist in the development of that ability a robot, the PHD, was designed and built with the 
capability to be used for two purposes. First, it can be used to perform research on joint 
torque control schemes, and second it can be used to determine the important dynamic 
characteristics of the Harmonic Drive gear reducer. 

The PHD, is a planar, three degree of freedom arm with torque sensors integral to 
each joint allowing joint torque feedback to be implemented. Preliminary testing using the 
PHD has shown that a simple linear spring model of the Harmonic Drive's flexibility is 
suitable in many situations. Future work with the system could include a more detailed 
Harmonic Drive model, as well as development of joint torque feedback schemes for force 
control. 
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Chapter 1: Introduction 


This thesis describes research in two different areas. The first is the creation and 
verification of a model for the simulation of a commercially produced robot arm purchased by 
NASA’s Goddard Space Flight Center. The second is the construction and testing of the 
PHD robot, a planar robot built using the Harmonic Drive used as a gear reduction. The 
PHD will be used for the testing of joint torque control strategies as well as determining a 
suitable simulation model of the Harmonic Drive. The following chapter introduces the 
research and discusses its relevance. 


1.1 Control Background 

In order for robots to perform useful tasks we must be able to control them. This 
control can either be done using a human being teleoperating the robot, or by a computer 
generating high level commands. In either case these commands must be converted into 
lower level commands to be executed by the robot. In many applications, robotic systems 
are being discovered to require more and more precise control in order to accomplish their 
chosen task. This is seen in areas such as parts assembly, where robots are required to 
accurately position parts to thousandths or even ten-thousandths of an inch. Other tasks such 
as surface grinding require force control—the ability of a robot to exert a commanded force— 
in order to be successful. The remainder of this section gives a brief overview of control, 
beginning with position control, then moving to force control and finally examining one 
particular force control scheme called joint torque control. 
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1.1.1 Position Control 

Position control allows robots to move from one place to another. The most common 
scheme for doing this is a simple P.I.D. control loop based on a position and velocity 
feedback signals. Many more intricate and complex schemes have been devised which allow 
higher precision control, usually at the expense of requiring more computing power. Some 
examples of these include estimator design and full state feedback. Position control has 
significant limitations when it comes to doing many robotic tasks as it has little ability to deal 
with uncertainties in its environment or errors in its task. For example, when a position 
control scheme is being used to assemble parts, the tolerances on the parts must be very 
accurate in order to achieve a reasonable success rate. If parts are out of tolerance and they 
collide during assembly then there is no means for the system to recover. Alternatively, if a 
robot is picking up an object, monitoring its force output is a good way of telling whether or 
not it has been successful, position control lacks this ability. 

A good way to solve some of these problems involves sensing the force being exerted 
by the robot and incorporating that signal into the feedback control system. This allows the 
system to react to its environment. One such method proposed by Paul [15] involves 
integrating position and force control into a hybrid scheme, allowing position control in some 
directions and force control in others. 

1.1.2 Force Control 

In some tasks, it is desired is to generate a commanded force in a certain direction 
with position being of secondary concern (e.g. grinding). Various approaches have been 
taken to allow accurate force control and many of these are documented by Whitney [20]. 
Research has been done by Maples [10] to classify the different schemes based on their 
method and some arguments have been made that certain approaches are inherently better 
than others. Good [6] and Eppinger [4] have worked to explain the reasons for limitations of 
force control by building more complex models and using them to show why problems occur 
in certain strategies. Both of these researchers stress the importance of analyzing the drive 
system elements when looking at a robotic system. 
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In force controlled systems, issues that are unimportant in position control suddenly 
become critical. When modelling such systems, parameters which have little effect on the 
position control model become more important. Therefore, to be able to generate a 
successful force control scheme it is important to build a relatively accurate system model. 
Such a model should include any structural modes, the characteristics of the drive train 
(motor, gearing, etc.) and any significant non-linearities in the system (Coulomb friction, 
amplifier current limits). Analyses of these types of models have offered much insight into 
the problems that occur in force controlled systems. 

More recently, other issues have emerged as important with regard to force control. 
These issues relate to whether the actuator and sensor are located together (collocated) or 
there is some flexibility between them (noncolocated). The rigid body bandwidth as well as 
dynamically collocated and noncolocated modes often serve to dictate the maximum 
achievable bandwidth of the force controller. Specifically, Eppinger [5] states that it is 
important to boost the lowest frequency noncolocated modes in order to improve 
performance of the system. According to Maples [10] another way to enhance performance 
is by controlling the robot in Cartesian space as opposed to joint space. This allows more 
flexibility in the control scheme which more than offsets the added computational burden. 

1.1.3 Joint Torque Control 

Another recent advancement is the use of joint torque feedback. This method 
proposes to feed back the torque across each joint to improve control. This was proposed by 
Hashimoto [7] and Tilley [18] as an effective method for improving position control 
strategies as it significantly improves disturbance rejection. This method is used 
predominantly in systems where an actuator is driving a joint through a large gear ratio 
although Asada [1] showed it is also useful in minimizing the effects of non-linearities in 
direct drive joints. As documented by Pfeffer [16] and Luh [9] the torque sensor located on 
the output of the gear reduction allows the system to compensate for friction and 
nonlinearities present in the drive and gearing. As shown by Tilley [19] it also improves 
backdrivability. Now researchers such as Sundaram [17] are interested in probing the 
advantages of using joint torque sensing in force control strategies. This approach provides a 
middle ground between directly measuring endpoint force and simply using motor current to 
control endpoint force. This type of scheme, if successful, will provide a means for robots 
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to perform tasks in unstructured environments where the need for force control is more 
important. 


1.2 NASA Background 

One area where robots can be of great use assisting humans is in space. The planning 
required to send a robot into space to repair a satellite or assemble a structure is significantly 
less than that required to send a human. Therefore, teleoperating robots in space either from 
the Space Shuttle or even earth, is a useful goal. Since the tasks being done by the robot 
would often be in uncertain or unstructured environments this is an area where force control 
is indispensable. 

1.2.1 FTS Program 

The Flight Telerobotic Servicer (FTS) is one such robot system being built by NASA 
to operate remotely in space. Its main purpose is to assist astronauts with the construction 
and maintenance of the U.S. Space Station proposed for the mid 1990’s. It will be 
teleoperated from within the Space Station, allowing astronauts to perform assembly, 
inspection, and servicing without having to leave their protected environment. The FTS will 
also be able to operate from the Space Shuttle to perform initial assembly of the Space Station 
or perform maintenance on satellites in earth orbit. 
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Fi gure 1.1 Layout of the Flight Telerobotic Servicer 
(courtesy of Martin Marietta) 

The FTS will consist of a base platform mounted to a modified MMU (Manned 
Maneuvering Unit) allowing the FTS to move from place to place as shown in Figure 1.1. 
Three manipulators will be mounted on the platform, one five degree of freedom stabilizer 
arm used to hold the platform stationary, and then two seven degree of freedom manipulator 
arms for performing whatever tasks are necessary. A full complement of end effector tooling 
will allow the robot to perform a wide variety of tasks. Operator feedback will be 
accomplished via two adjustable color cameras mounted on the platform as well as smaller 
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wrist cameras mounted on each of the manipulator arms. This will allow the robot to 
perform tasks out of the operator's direct view. 

1.2.2 Martin Marietta's Work 

The primary contractor selected to design and build the FTS system is Martin 
Marietta's Space Systems Division. The planned schedule is to launch a partial prototype 
system with the Space Shuttle on a test flight in 1991, followed by a full prototype test in 
1993. The final system should be operational in the mid 1990's as Space Station 
construction commences. Currently, Martin Marietta is involved in designing the seven 
degree of freedom manipulator to be used, additionally they are developing the platform and 
stabilizing arm. 

To allow the FTS to perform tasks such as replacing electronic components or 
manipulating delicate instruments research is needed in developing robust force control 
strategies. Also, Martin Marietta is interested in being able to accurately predict the robot's 
performance, so they need to develop detailed computer models and simulations of all parts 
of the FTS. They want to be capable of building models of differing complexities so that 
simulations can be run faster or slower depending on the desired accuracy of the results. In 
order to do this it is necessary to develop detailed models of the components of the arm. One 
particular area where work is needed is in exploring the performance characteristics of the 
Harmonic Drive. 

1.2.3 Harmonic Drive 

The Harmonic Drive (H.D.) is a commercially produced gear reducer based on a 
principle of using a non-rigid, continuous deflection wave to achieve large gear ratios in a 
small package. Its main advantages are: 

• large ratios can be obtained (up to 200:1) in a small module 

• input and output rotations are coaxial 

• units can be produced with zero backlash 

• high output torques can be achieved 
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The drive consists of three parts, a "circular spline*, a "flexspline" and a "wave 
generator". The common configuration is to have the wave generator serve as the input 
driven by a motor at high speed. The circular spline is then attached to "ground" and the 
flexspline rotates at the motor speed divided by the gear ratio and has an output torque of 
roughly the gear ratio times the input torque. Typical efficiencies for the drives are between 
60% and 85% and maximum torque outputs range from 30 in lb to 7500 ft lb. A picture of 
the Harmonic Drive is shown in Figure 1.2. 


Circular Spline 

A rigid, internal 
gear 


Wave Generator 

An elliptical ball 
bearing assembly 



Flexspline 

A nonrigid, external 
gear 


Eiaire 12 Harmonic Drive 

The operational principle of the drive is to place the elliptical wave generator inside of 
the flexspline causing it to deflect into an ovular shape. The flexspline has small gear teeth 
on its outside which mate in two places (along the major axis of the ellipse) with similar teeth 
on the inside of the circular spline. Then, as the wave generator is rotated consecutive teeth 
mesh between the flexspline and circular spline. Since the circular spline has two more teeth 
than the flexspline one revolution of the wave generator causes the flexspline, to move 
backward two teeth with respect to the circular spline, thus giving the desired gear ratio (see 
Figure 1.3). The best way to understand the operation is to examine one up close. The 
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Harmonic Drive was "invented" by Walt Musser in 1955 and modified little since, although 
currently some research has been done by Kondo [8] on modified tooth profiles in order to 
optimize performance. 


For every 180* rotation of the wav# generator, 
flexsDlne rotation lags by one tooth 



NOTE: CLEARANCE BETWEEN SPUNE TKTH IS EXAOOWATH) 


Figure 1.3 Description of Harmonic Drive Operation 


1.3 Design of a Test System 

The PHD is a Planar, Harmonic Drive robot built as a research tool to study two 
separate issues, joint torque control and Harmonic Drive performance characteristics. It has 
three joints: shoulder, elbow, and wrist which all rotate in the same plane. The PHD was 
designed to be modular and easy to assemble and disassemble. Each of the joints consists of 
two parts, the joint housing and the drivetrain. There are three main components that make 
up the drivetrain: the motor, the Harmonic Drive and the torque sensor. The torque sensor is 
designed to measure the torque across the joint, allowing various joint torque control 
schemes to be tested using the robot. 

The PHD has been designed primarily as a robot to study joint torque control 
strategies. Another goal of the design is to allow the robot to be used to study the dynamic 
performance of the Harmonic Drive gear reducer. Each joint has a torque sensor allowing the 
measurement of the torque across the joint which can then be fed back to the controller. 
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Additionally, the shoulder and elbow joints have tachometers integral to the motors to permit 
velocity feedback and all three motors are equipped with encoders to allow position feedback. 
All three joints rotate in the same plane, the shoulder having 180° rotation, the elbow having 
270° rotation, and the wrist being able to rotate continuously. The shoulder joint is equipped 
with an extra encoder allowing the joint position to be measured directly. This data can be 
combined with the motor encoder data allowing the position of both the input and output of 
the Harmonic Drive to be monitored. This, in conjunction with the torque sensor, allows 
more accurate dynamic characterization of the Harmonic Drive. 

The remainder of this thesis is divided into the following chapters: 

Chapter 2: Presents the details of our efforts to build an accurate simulation of the 
performance of the RRC arm purchased by NASA. The chapter shows the model 
development and revision based on experimental results obtained from the arm. Finally, a 
brief discussion is presented of what is required to extend the model to predict force control 
behavior. 

Chapter 3: Discusses the important issues considered while designing the PHD 
robot The motivation for many of the numerous design decisions is provided. Also, details 
as to the configuration and mechanical layout of the robot are presented. 

Chapter 4: Shows experimental results detailing the PHD's behavior. The first 
section outlines the tested capabilities of the robot. The second section presents the results of 
tests conducted on the Harmonic Drive, and presents a suitable model of the drive. 

Chapter 5: Conclusions of this research are given along with suggestions of areas 
for future research using the PHD. 
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As stated earlier, NASA's work on the Flight Telerobotic Servicer (FTS) included the 
need to produce an accurate simulation of the performance of the hardware. To build this 
simulation, research was needed to determine an accurate model of the seven degree of 
freedom manipulator arms to be used. In order to initiate research in this area, NASA's 
Goddard Space Flight Center purchased two commercially produced robot arms from 
Robotics Research Company (RRC) of Cincinnati, Ohio. These arms are seven degree of 
freedom arms similar to the design proposed for use in the FTS system. This chapter 
discusses our efforts to build a good simulation of these manipulators 

MIT was contracted in conjunction with researchers at the University of Iowa and 
Cambridge Research (a local company in Cambridge) to produce a dynamic simulation of 
these arms. The initial commitment from MIT was to research and determine a reasonable 
model of the controller of the robots. That is, to determine a set of equations that would 
predict the motor current given the input command and feedback signals. It was the 
responsibility of the group at the University of Iowa to develop the required kinematic model 
of the seven degree of freedom arm. Then Cambridge Research was to coordinate the 
integration of the full model into a suitable simulation package. 
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2.1 RRC Arm 


K-1607 DEXTEROUS MANIPULATOR 



Fi gure 2.1 Robotics Research Co. K-1607 Manipulator (courtesy of RRC) 

The specific arm chosen by NASA is the RRC K1607 manipulator. It is the 
anthropomorphic seven degree of freedom arm shown in Figure 2.1. Some of its more 
important specifications are listed in Table 2.1. 
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Model Specification: 

MPS K-1607-0986-IB 

Configuration: 

Jointed Arm 

Servoed D.O.F: 

7 

Max. Reach: 

63 in. 

Working Envelope: 

-600 cu. ft. 

Positioning Repeatability: 

0.005 in. 

Weight: 

500 lb. 

Max. Payload: 

25 lb. 

Construction: 

Cast Aluminum & Steel 


Table 2.1 Specifications for RRC K-1607 Manipulator (courtesy of RRC) 

The RRC arm has seven independent degrees of freedom: shoulder roll and pitch, 
elbow roll and pitch, wrist roll and pitch and toolplate roll. The drivetrain is similar to that 
proposed for the FTS system and consists of a DC servomotor turning a Harmonic Drive 
which drives each joint. Each joint has a torque sensor measuring the torque output of the 
Harmonic Drive (or the torque across the joint). Two of these arms are mounted side by side 
at NASA's Goddard Space Flight Center. They are being used to study what tasks can be 
performed and how two manipulators can be used together to perform more complex tasks 
than one single arm. Also, these arms were used to gather data to verify our simulation 
model. 


2.2 Position Control Model 

In order to build and test an accurate simulation of the controller of the RRC arm it 
was necessary for us to incorporate some physical dynamics into the model. Since it was not 
our responsibility to develop the kinematics for the seven degree of freedom arm, we chose 
to treat each joint separately so that no dynamic coupling was present. To implement this we 
started with a relatively simple model of the controller moving a simple load inertia. This 
model, when proven to be accurate, could be incorporated into the more advanced kinematic 
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model. This method of decomposition—MIT working on the one degree of freedom 
controller model and Iowa working on the seven degree of freedom kinematic model—made 
it simpler for research to happen in parallel as well as verify our own results at each 
successive step. 

2.2.1 Controller Modelling 

Since each joint of the robot is equipped with torque sensing capability this data is 
used in the controller. As mentioned earlier, this form of torque feedback serves to remove 
the nonlinear effects present in the Harmonic Drive and motor as well as frictional effects 
present in their bearings. Figure 2.2 shows a block diagram which outlines the basic model 
used for position control. 



Fi gure 2.2 Block Diagram of Position Control Model 

In this scheme the joint position is fed back and compared to the desired position and 
fed into the position compensator. This produces a velocity command which is compared to 
the actual velocity and fed to the velocity compensator. Finally, this generates a torque 
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command which is compared to the measured torque and fed to the torque compensator. 

Thus, there are three feedback loops in the model, corresponding to the position, velocity and 
joint torque. The innermost loop on the block diagram is not an electrical feedback signal 
but a block diagram representation of what is physically happening in the system. It accounts 
for the reaction torque from the transmission which acts on the motor rotor. This 
representation presumes that the transmission can be modelled as an inertia (lumped in with 
the motor rotor inertia), a 100% efficient gear ratio, and a spring representing the flexibility 
of the Harmonic Drive. 

The controller model ends internal to the torque compensator block, when it sends a 
signal to the amplifier. Therefore, we were primarily interested in the first three blocks and 
feedback loops in the diagram. The torque compensator block also takes into account the 
amplifier and motor electrical dynamics. Its output is the motor torque, which then has the 
reaction torque subtracted from it. The result is the total torque acting on the motor rotor, 
which accelerates the motor rotor and acts to "wind up" the spring which drives the joint. 

This representation is kind of subtle but it is consistent with the physical system. It is the 
inherent "springiness" of the Harmonic Drive that allows this representation to work. 
Essentially, the motor and joint are on opposite ends of a spring. The available feedback 
signals are the torque through that spring and the position of the joint. On the RRC arm there 
is no direct position feedback available from the motor, instead the joint position is measured. 

For the simple model shown in Figure 2.2, the amplifier/motor pair is represented by 
a perfect torque source, taking the motor current and turning it directly into a torque acting on 
the motor rotor. This assumption is justified because the amplifier coupled with the motor 
electrical effects responds very quickly, driving the motor inertia with the commanded torque 
almost immediately. As we will show later, this assumption breaks down when we begin to 
develop a force control model. The dynamic model includes the motor inertia and viscous 
damping, the gear ratio of the transmission, a spring rate associated with the transmission 
flexibility, and a load inertia and damping. The values for the inertia and viscous damping in 
the motor were obtained from the motor manufacturer, the transmission stiffness was quoted 
in the Harmonic Drive literature, and the joint inertia and damping were obtained from RRC. 

Since we were building a dynamic model of a single degree of freedom, we needed to 
decide which physical properties were important to include. In a system with a transmission 
such as this, it is important to consider the motor mechanical dynamics (rotor inertia and 
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damping) in any model because for large gear ratios, motor dynamics can become more 
significant than joint and load dynamics. It must be recalled that when accelerating the 
system, the motor must drive an inertia equivalent to the motor inertia plus the joint inertia 
divided by the gear ratio squared; for example on the RRC arm a typical gear ratio is 200, so 
that the equivalent inertia the motor is accelerating is the joint inertia divided by 40,000 plus 
the motor inertia. In many cases the equivalent joint inertia is small compared to the rotor 
inertia, allowing the controller to drive a load which is roughly constant regardless of the 
robot configuration. However, due to the RRC arm’s rigid, heavy design (and therefore 
large joint inertias), the joint inertias are significant for the inner joints (shoulder, elbow). 
Pasch [14] gives a detailed discussion of these considerations. 


It is important to emphasize at this point that our goal in this exercise was to model 
the existing RRC arm and not to optimize its performance. The models of the compensators 
were provided by RRC. The first model we arrived at is shown in Figure 2.3. 



Figure 2.3 Linear Model of Typical Joint 

This linear model seemed to provide reasonable response for the larger joints but 
when simulations were run on the smaller joints (wrist pitch and toolplate roll) they were 
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found to exhibit some instabilities (see Figure 2.4). Since the real robot is stable, this implies 
that either our model was inadequate or its parameters were incorrect. Since we were 
relatively confident about the parameters, we decided to pursue a more detailed system 
model. 



Time (sec) 

Figure 2.4 Simulated Step Response for Wrist Pitch - Linear Model 

2.2.2 Non-linear Model 

The most apparent elements missing in the linear model were the quoted non-linear 
spring characteristics of the Harmonic Drive and the unmodelled Coulomb friction in both the 
motor and joint. We added these effects to the model and again looked at simulation results 
and found that all seven joints were stable and well behaved using this model. Now that we 
had a stable model we needed to verify its accuracy. The non-linear model is shown in 
Figure 2.5. 
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Figure 2.5 Non-linear Model of Typical Joint 


2.2.3 Testing 

The next step was to obtain actual experimental data from the RRC arm which we 
could compare to our model's predictions. To do this, we first designed a test plan which 
would yield results we could correlate to our model. Since our model represents only one 
single degree of freedom, all of the tests were run on only one joint with the others 
commanded to zero. The robot was always placed in a configuration such that the tested 
joint's motion would be in the horizontal plane, in order to keep the load inertia from 
changing during motion. The joint inertia for the model was calculated based on the testing 
configuration and it consisted of the equivalent inertia of all of the joints on the distal 
(outboard) side of the joint being tested. Also, the test configurations were chosen in order 
to minimize any dynamic interactions between the joints. This was accomplished, as much 
as possible, by keeping the tested joint's rotation perpendicular to all other joints' axes of 
rotation. 
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The experimental data compares favorably with the simulation results, although there 
are some differences. The comparisons for the elbow roll and wrist pitch joints are shown in 
Figures 2.6 and 2.7. The simulation results have the same rough shape as the experimental 
data but there are still discrepancies. Performing parameter studies of our position control 
model enabled us to evaluate the simulation's sensitivity to the various modelling quantities. 
This was done by choosing a confidence interval for each parameter, within which we 
believed the true value to lie. The simulation results were examined to see if their outcome 
was strongly affected by changing the parameter within this interval. 



Figure 2.6 Step Response for Elbow Roll - Non-linear Model 
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Figure 2.7 Step Response for Wrist Pitch - Non-linear Model 

The results showed, as expected, that our position control simulation was most 
sensitive to the parameters in the outer loop, that is the position feedback and compensator 
gains. For the joints closer in to the base (shoulder roll and pitch, elbow roll and pitch) the 
effective joint inertias arc significant with respect to the motor inertias so their values arc also 
important. For the outer joints (wrist roll and pitch, tool plate roll) the motor inertia 
dominates so the joint inertia becomes less significant The value of the motor rotor inertia 
also affects the results considerably for all the joints. The position control simulation is not 
particularly sensitive to values of either the motor or joint viscous damping and, although it 
was important to include the Coulomb friction in the model, changing its value up to an order 
of magnitude does not affect the results significantly. 

2.2.4 Model Improvements 

With regard to the reported compensator gains, the simulation output is affected 
considerably for values within the confidence range. Based on this knowledge we obtained 
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more accurate estimates of their values and subsequently improved our results substantially. 
Figure 2.8 shows simulation and experimental results for the tool plate roll with old and new 
values for the position compensator gain. Possible inaccuracies in the reported joint inertias 
also affect the simulation for the inner (shoulder and elbow) joints and we have not yet been 
able to refine their values. 



Figure 2.8 Comparison of Step Responses for Toolplate Roll - Non-linear Model 
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2.3 Force Control Model 



Him (nc) 


Figure 2.9 Transmission Torque Data for Toolplate Roll - Experimental Results 



Figure 2.10 Transmission Torque Data for Toolplate Roll - Simulation Results 
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The next step was to try to extend the position control model into the force/torque 
control domain. Initially, this simply involved comparing the simulated motor current and 
torque output of the joint to the experimental data under position control. To build a suitable 
model for force control, it is important to verify that the simulated and experimental torque 
output of the drive correspond closely. Similarly, the motor current has a strong influence on 
the motor torque, which is also significant in predicting force control performance. Figure 
2.9 and 2.10 show simulation and experimental torque outputs for toolplate roll and as it can 
be seen there are significant differences. Further research into the cause of these 
discrepancies has been performed and important elements were found to be missing in the 
model. Two of these effects are current and voltage limits in the amplifier which dictate the 
max imum capabilities of the amplifier. The simple and revised models for the amplifier and 
motor are shown in Figures 2.11 and 2.12. The results obtained using the new model are 
shown in Figure 2.13. As you can see, the revised model provides simulation results that 
better correlate to the experimental data. The noise in the experimental data is due to the fact 
that we were making very small moves, and thus the torques produced were small (i.e. near 
the resolution of the torque sensor). Sundaram [17] presents more research into improving 
the model for torque control as well as modelling and developing torque control strategies in 
general. 


Current 
Command 
(in Volts) 


Amplifier 

Current^ 

Torque 

Gain 


Constant 


Torque 


Figure 2.11 Simple Model of Amplifier and Motor 





Chapter 2: NASA Modelling Research 


Saturation 



Figure 2.12 Revised Model of Amplifier and Motor 
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Figure 2.13 Transmission Torque Data for Toolplate Roll - Revised Motor/Amp Model 
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This chapter details the design and construction of the PHD. It begins with a 
discussion of the motivation for the robot and the selection of the various attributes of the 
design. Then the mechanical configuration of the robot is shown in detail. Finally, the 
wiring and computer control issues associated with the robot are discussed. 


3.1 Motivation/Goal 

The primary goal of the PHD was to produce a research tool which could be used to 
research joint torque control strategies. In order to achieve joint torque control each axis is 
equipped with a sensor measuring the torque across that joint. This allows us to explore 
different methods of using torque feedback to control the endpoint force. A secondary goal 
of the PHD was to be able to research the performance characteristics of the Harmonic Drive. 
The overall design was aimed at satisfying both of these goals. 


3.2 Attributes 

In the design of any robot, there are many decisions which must be made and usually 
these decisions are made to satisfy the constraints posed on the problem. There were several 
constraints initially imposed on the design of the PHD. Some of these were dictated by us 
and others were inherent in the design goals. The first important choice we made was that 
the robot would be planar. Since many force control schemes have been demonstrated with 
moderate success on single degrees of freedom systems, we felt a one axis system was 
overly simple. Alternatively, very few schemes have been successful in achieving useful 
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force control on systems with multiple degrees of freedom. Therefore we chose to go with a 
multiple degree of freedom robot. We did not feel it was necessary to build a six (or more) 
degree of freedom arm, but that a three degree of freedom arm would be complex enough to 
develop strategies applicable to more complex systems, while not being as computationally 
intensive as larger systems. The choice to build a planar robot was made in order to allow 
the robot to accomplish simple tasks, such as planar assembly tasks (board insertion, 2-D 
peg in hole). Next, issues such as size, strength, and configuration had to be addressed. 


3.2.1 Size 

The size of a robot often is dictated by the tasks it will do. In the case of the PHD a 
nominal task we chose was computer board insertion. This implied that we needed a work 
envelope of at least a few square feet. We chose to use the 2' by 4' platform of another robot 
we had in the Artificial Intelligence Lab (the Cartesian robot) as a base since it was of 
reasonable size to perform the nominal tasks we had in mind and also since it was very rigid 
(well, as rigid as the 9 th floor of a building built on a marsh can be). This constrained the 
work envelope and thus gave a rough idea of the size of the robot. Another constraint on the 
size came from the desire to build a stiff system, this requirement will be discussed below 
(section 3.2.5). 

3.2.2 Joint Configuration 

The joint configuration of a robot dictates what kind of motions it will be able to make 
and what the shape of its useful work envelope will be. The configuration for the joints (and 
links) of the PHD allow the robot to reach most parts of the base it is mounted on. Since the 
goals of the PHD were to test joint torque control and look at Harmonic Drive performance, 
we decided that three planar, rotary joints would be more useful than any sort of linear 
motion. After considering a few different configurations it became apparent that having the 
robot capable of folding back on itself (i.e. the tip could touch the base) was important in 
increasing the usable workspace. This also dictated that the links between the base and first 
joint and first joint and tip be about the same length. Of the several different configurations 
considered, the one we selected is depicted in Figure 3.1. 
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Wk> 



Figure 3.1 Top and Side View of the PHD Robot 

The chosen configuration is an anthropomorphic design with three joints. The first 
joint, or shoulder, is fixed to the base and rotates 180° (it could rotate continuously, except 
the cables would fail). The second joint, or elbow, is just over 12" (center to center) from 
the shoulder. The incoming and outgoing links are connected to the elbow joint in such a 
manner as to allow it to rotate all the way back on itself on one side. Due to the cable 
routing, it can only turn halfway back on the other side, giving it a total of 270° of rotation. 
The final joint, or wrist, is mounted 12" from the elbow. This joint's output is a continuous 
rotation of its bottom plate. Currently, a 4" link is mounted as the output, but in general this 
plate serves as the mounting point for any end effector. An outline illustrating the PHD's 
work envelope is shown in Figure 3.2. 
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Figure 3.2 Work Envelope of the PHD Robot 


3.2.3 Modularity 

One feature that we tried to include in the design was modularity. Each joint is a 
separate unit and it is relatively easy to disconnect a joint and run it alone. There are three 
links, the first between the shoulder and elbow, the second between the elbow and wrist and 
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the third serving as the end effector. The ends of first two links are identical so the joints can 
be swapped into different configurations. For example, the elbow joint could be eliminated, 
producing a simpler two degree of freedom system. Alternatively, the design for the elbow 
could be reproduced with the same size Harmonic Drive but a different gear ratio and motor 
giving a four joint arm to experiment with. Also, the joints can be turned 90° so the robot no 
longer has simple planar motion. One final feature is that the links can be changed with 
relative ease, so the robot could be used to explore the advantages and disadvantages of 
different ratios of inner link length to outer link length. The only limiting factor here is the 
length of the cables, which was chosen to suit the current configuration. 

3.2.4 Power/Strength 

The PHD's strength was chosen so as to be appropriate for a typical task. As 
mentioned earlier, a typical force control task we would be interested in would be inserting a 
computer card into a cage. Roughly speaking the nominal force needed to complete such a 
task is about 5 lbs., so we decided a continuous force of 10 lbs. as the spec for minimum 
linear force output at the endpoint. The actual capabilities of the PHD are somewhat higher, 
in order to provide some adaptability if the configuration is changed. Each joint is powered 
by a brushed D.C. motor driving a Harmonic Drive gear reducer. The H.D.'s were all 
purchased as backlash free units in order to give the robot improved performance and added 
stiffness. 

3.2.5 Natural Frequency 

The final important characteristic of the robot is its natural frequency of vibration. As 
stated earlier, the first mode of vibration of the system is dominant in determining the 
achievable bandwidth of the system. In order to obtain an estimate of the lowest natural 
frequency of the robot we can use a convenient formula relating endpoint deflection to natural 
frequency. This formula is based on a simple model of a mass at the end of a cantilever beam 
suspended in a gravity field as shown in Figure 3.3. 
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Fi gure 3.3 Cantilever with Suspended Load 

To derive this relationship for the natural frequency of this system we start first with 
the formula for the deflection, 3, of a simple cantilevered beam with a load at its tip (see 
Blevins [2]). 

3 

n PL 

3EI (3.1) 

where 

p = mg (3.2) 

This formula assumes that the mass of the beam is negligible in comparison to the end load. 
Now that the tip deflection is known, the equivalent spring constant for the beam, K, can be 
expressed as 

P m g 

K = J = T (3.3) 


A reasonable (first order) approximation of the natural frequency (in Hz.) of this 
beam is given by 


, = -i_ fiL 

1 2*V m (3.4) 


and by substituting equation 3.3 for K in this expression we find 
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1 /g 

/ = 2W3 (3.5) 

This gives a convenient relationship between endpoint deflection and natural 
frequency. It can be shown that this formula is also a good approximation for two link 
systems, as long as the joints are of the same relative stiffness. Some work showing this 
was done by Christian [3]. For a system such as the PHD we must analyze each joint as if 
the robot was hanging sideways, so that gravity would cause the joints to sag. By knowing 
the stiffness of the joints, the total amount of endpoint sag can be predicted, and thus a 
reasonable prediction for the natural frequency can be obtained. 

For our robot we wanted to push this frequency as high as possible. This meant 
building a system as stiff as possible (or minimizing the endpoint deflection). After 
evaluating the different elements of the system it became evident that the torque sensor and 
the Harmonic Drive were the most flexible elements in the drive system. All the other 
elements could be made comparatively stiff. Since we were designing the torque sensor 
ourselves (see section 3.3.2), we chose to make it significantly stiffer than the H.D. For the 
H.D., there was litde we could do about the stiffness, so it became the deciding factor in 
determining the first mode of vibration of the robot. Using the method discussed above, the 
predicted natural frequency for the robot in a fully extended configuration is around 22 Hertz. 


3.3 Mechanical Configuration 

An isometric drawing of the PHD is shown in Figure 3.4. It decomposes into six 
basic parts; the shoulder joint, the first link, the elbow joint, the second link, the wrist and 
the output link or end effector. The design of the three joints of the PHD are very similar. 
The shoulder and elbow joints are almost identical except for their size, and the wrist is 
slighdy different due to the desire for continuous rotation at the output. The joints were 
designed to be as light and compact as possible. All the machined parts of the joints 
(everything except the H.D. and motor) are made from aluminum. To provide sufficient 
stiffness, the links were made out of steel tubing silver soldered into two (steel) end caps 
which are then bolted onto the joint. The joints decompose easily into two parts, the joint 
housing and the drivetrain. 
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Fi gure 3.4 Isometric View of the PHD Robot 
3.3.1 Joint Housing 

The joint housing consists of an inner cylinder and an outer cylinder separated by 
bearings to allow them to rotate with respect to each other. A cross sectional view of the 
elbow joint housing is shown in Figure 3.5a and the wrist in Figure 3.5b (both joints are 
shown without the drivetrain). The bearings are thin section angular contact bearings 
mounted back to back to achieve the maximum moment load capabilities. The bearings are 
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pressed into the outer cylinder and then slipped over the inner cylinder. They are held in 
place between a lip on the bottom of the outer cylinder and its cover (the top plate), which is 
bolted into the cylinder on its top face. Then the cover on the top of the inner cylinder is used 
to preload the bearings enough to remove all backlash. There is also a bottom plate on the 
inner cylinder which forms the base on the shoulder, the input or base on the elbow, and the 
output rotation on the wrist. Finally, the links are bolted into the sides of the cylinders. 



Link (To Wrist ->) 


Inner Cylinder 


Outer Cylinder 


(<- To Shoulder) Link 


Base Plate 


Figimfi 3.5a Cross Section of Elbow Joint Housing 



Figure 3.5b Cross Section of Wrist Joint Housing 


3.3.2 Drivetrain 

The drivetrain consists of three main parts: the motor, the Harmonic Drive and the 
torque sensor. A cross section of the drivetrain for the shoulder and elbow joints is 
illustrated in Figure 3.6a and the wrist is shown in Figure 3.6b. The motors for all three 
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joints are brushed D.C. servomotors. The first two are Aerotech permanent magnet motors 
with integral tachometers (see Appendix B for hardware specifications), and the third is a 
Clifton Precision samarium cobalt magnet motor without a tachometer. All three motors have 
Hewlett Packard optical encoders to allow motor position feedback. The motor case is 
mounted to an adapter plate which also holds the Harmonic Drive circular spline. The motor 
rotor then spins with the H.D. wave generator. This, in turn, causes the flexspline to turn 
relative to the circular spline (at the motor speed divided by the gear ratio). On the shoulder 
and elbow the torque sensor is bolted to the flexspline output For the wrist, the torque 
sensor is mounted to the circular spline as shown in Figure 3.6b. This is done so that the 
torque sensor rotates with the input instead of the output, and therefore the joint can rotate 
continuously without worrying about the torque sensor cable winding up. 


Encoder 


Tachometer 


Motor 



Motor Adapter 
Circular Spline 

Flexspline 
Wave Generator 
Torque Sensor 


Figure 3.6a Cross Section of Elbow Drivetrain 
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Encoder- 

Motor- 

Motor Adapter- 

Torque Sensor Cover 

Circular Spline- 

Torque Sensor- 

Wave Generator- 

Flexspline- 

Spacer Cylinder- 


Figure 3.6b Cross Section of Wrist Drivetrain 

The drivetrain and joint housing can be are assembled separately and then mounted 
together. The drivetrain is placed inside the joint housing and the bottom of the torque sensor 
is bolted to the base plate on the bottom of the inner cylinder. Next, the circular spline and 
motor adapter plate are bolted to the top of the outer cylinder. The relative motion of the 
circular spline and flexspline then causes the joint to rotate. A cross section of the assembled 
joints are shown in Figures 3.7a and 3.7b. 
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Figure 3.7a Cross Section of Assembled Elbow Joint 
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Figure 3.7b Cross Section of Assembled Wrist Joint 
Harmonic Drive/Motor Selection 

The choice of motor and Harmonic Drive is an important factor in determining the 
performance characteristics of the robot. The motor and gear ratio combine to determine the 
speed with which the system can react. Additionally, as discussed above, the Harmonic 
Drive provides the majority of the flexibility in the system, so this decision must be 
considered carefully. Many different motor and reducer sets were considered using a spread 
sheet to analyze the different combinations, as shown in Appendix D. 

Selecting the Harmonic Drive was the first consideration. Harmonic Drives are 
available in a range of models (sizes) and then each model is available in a variety of gear 
reductions. The output rotational stiffness of the drive depends solely on the model and not 
on the reduction (the input stiffness is influenced by the ratio chosen). Since we were 
concerned about keeping the first mode of the system as high as possible we wanted to 
choose the stiffest drive possible, which meant choosing as large of a Harmonic Drive as 
possible. Since the largest drive is 13" in diameter we decided on a more moderate size 
which could be accommodated in our design. 

The next decision was to choose an appropriate reduction, but this had to be done in 
conjunction with selecting the motor. The method we used for doing this was to first identify 
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an appropriate set of motors for each joint representing a range of different torque, speed and 
weight characteristics. These were then entered into a spread sheet and paired with different 
H.D. ratios to select drives for each joint. It is important to have comparably powered drives 
for each joint so that one of the joints is not overpowered or underpowered with respect to 
the others. The final motor and Harmonic Drive selections are documented in Table 3.1. 
These combinations provide a maximum linear output force of around 30 lbs. with the arm at 
full extension. 



Motor 

Harmonic Drive 

Shoulder 

Aerotech 1035DC 

Model 1M-160 Reduction 

Elbow 

Aerotech 1017DC 

Model 3C-160 Reduction 

Wrist 

Clifton SmCo AS-780 

Model 1C-80 Reduction 


Table 3.1 Motor/Drive Choices 


Torque Sensor Design 

As the PHD's design evolved, the design of the torque sensor became a major part of 
the joint design. Initially, we examined several commercially produced sensors but soon 
decided that they would be difficult to integrate easily into the design. Additionally, these 
sensors are expensive and most are not as stiff as we desired. Therefore, we concluded that 
we would design and build our own strain gage based torque sensor. This decision had a 
significant influence on the design as it allowed us to locate the sensor where we wanted and 
also choose its stiffness. We chose to use a strain gage bridge mounted on a cylindrical 
sensor to measure torque across the joint as shown in Figure 3.8. This design prevented us 
from increasing the sensor stiffness arbitrarily since too stiff of a sensor would not provide 
enough strain for the gages to measure. There is an intricate coupling between the physical 
dimensions of the sensor, its stiffness and the sensitivity of its readings. We decided that we 
desired the stiffness of the sensor to be about an order of magnitude higher than the 
Harmonic Drive for that joint This would keep the sensor from significantly affecting the 
joint stiffness and lowering the system bandwidth. 
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Figure 3.8 Design for the Shoulder Torque Sensor 

The location for the sensor was chosen to accommodate the joint design. In the 
shoulder and elbow designs, the sensor is placed between the H.D. flexspline and the base 
plate on the joint. This allows it to measure the torque acting across the joint In the wrist 
the location is slightly different in order to allow continuous joint rotation. The wrist sensor 
is mounted between the circular spline and the joint housing. This allows us to still measure 
the torque across the joint but at the other end of the drivetrain. 

As mentioned, the dimensions of the sensor were chosen so that the sensor would be 
about an order of magnitude stiffer than the H.D. It was important to verify that we could 
accomplish this while still having enough strain in the sensor to allow the strain gages to 
measure accurately. The basic approach was as follows. First the sensor was modelled as a 
tube in torsion whose angular deflection, ©, is given by 

0=^ 

GI p (3.6) 

where T is the torque acting on the tube, L is the length of the tube, G is the shear modulus 
of elasticity and Ip is the polar moment of inertia of the tube. Solving this for the rotational 
stiffness, Kq, we get 
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(3-7) 


Since the length was roughly fixed by the design, this gives us the required polar 
moment of inertia for the sensor. The outer diameter (D 0 ) was selected to be as large as 
physically possible to allow the maximum strain for a given torque and stiffness. Given the 
O.D. of the sensor the inner diameter (Di) can be found using the following formula for the 

polar moment of inertia of the cylinder 



(3.8) 


Next, it was necessary to verify that the stress on the sensor was within the limits for 
the chosen material (aluminum). This was done by calculating the stress on the outside 
surface while the joint was exerting its maximum torque. The formula used for the stress, x, 

is 


X = 
max 


T D 

max o 




(3.9) 


Finally, it was important to verify that the strain on the outer surface was large 
enough to be measured using a conventional strain gage bridge. The gages are mounted on 
the outer surface and measuring strain in the 45° direction, so the formula for the strain, e, is 


^max 


rp pv 

^gL(l+v) = Bg -^l+v) 
E 2EIp 


(3.10) 


where E is the modulus of elasticity and v is Poisson's ratio for the material. 

Finally, it must be verified that this strain will produce a reasonable voltage difference 
using a Wheatstone bridge configuration. The gages we chose have two opposing 45° 
resistances with one common terminal as shown in Figure 3.9. Four of these gages were 
mounted at 90° increments on the cylinder and wired as shown in Figure 3.10. Each leg of 
the bridge had two 350Q resistances in series. Mounting the gages at 90° increments on the 
cylinder surface (see Figure 3.8) minimizes any bending strain that may occur in the torque 
sensor. 
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Figure 3.10 Layout for Strain Gage Wiring 
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(3.11) 


The formula relating output voltage, V 0 , to input voltage, V s , is 

V S AR 


Where the resistance change, AR, is related to the strain by the gage factor, Y> as 

AR/R AR/R 
Y _ AL/L e 


( 3 . 12 ) 


This factor, y, is dependent on the composition of the gage which is chosen to closely match 
the thermal properties of the material it is being mounted on. If the gage and sensor material 
have similar coefficients of thermal expansion then the effect of strain due to temperature 
changes will be minimal. Temperature changes will affect the gage resistance slightly, but 
having a four (or eight) gage Wheatstone bridge minimizes these effects. Therefore, for this 
configuration the formula that relates the strain to the output voltage is 

V„ = eyV s (3.13) 


and the maximum output voltage of the sensor is 

= T v s T max Do (1 + v ) 

°' max 2EIp (3.14) 

This voltage must be high enough to be transmitted to the electronics box where it is 
amplified. This location was chosen over an earlier idea of placing the amplifier on board the 
joint, due to packaging and noise problems. In Appendix A, the final design for the sensors 
are shown along with their important characteristics, such as maximum strain and sensor 

voltage levels. 

The formulas for the strain gages were applied iteratively until a combination was 
found that satisfied the stiffness requirement with acceptable strain sensitivity. This method 
worked for the shoulder and elbow gages but the wall thickness for the wrist sensor was too 
thin (1/64") to be robust. The design for the wrist sensor was modified by removing the wall 
completely in some spots, leaving six posts where the gages are mounted. The wrist torque 

sensor is shown in Figure 3.11. 
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Figure 3.11 Isometric Drawing of Wrist Torque Sensor 

3.3.3 Shoulder Position Sensor 

One additional component was added to the design to accommodate the goal of testing 
the Harmonic Drive. This is an extra encoder mounted on the outside of the shoulder to 
allow direct measurement of the joint position. This encoder will provide us with the joint 
position or position of the H.D. output whereas the motor encoder measures the motor 
position or position of the H.D. input. Therefore, we can monitor position on both sides of 
the Harmonic Drive. This data, in conjunction with the torque sensor data will allow us to 
gather data on the H.D. and determine its important dynamic properties. 

The extra encoder body is a 2500 line optical encoder mounted to the base of the 
shoulder. It is driven through a large diameter (6") precision gear which meshes with a 
smaller gear mounted on the encoder shaft. The smaller gear is an anti-backlash gear to 
prevent slip between the two gears. The pair of gears give a reduction of eight yielding a net 
resolution of 20,000 counts/joint revolution, which is about one-eighth as good as the motor 
encoder (1000 counts/motor revolution = 160,000 counts/joint revolution). 
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3.4 Computer Considerations 

A significant part of any robot is the computer hardware and software used to control 
the system. For the PHD, this system consists of four main components: a computer rack, 
an amplifier rack, and two junction boxes located near the robot base. The computer rack is 
where all the data processing and control takes place. The amplifier rack is where the motor 
amplifiers are located as well as the power supply for the torque sensors. Finally, there are 
two junction boxes, a "motor box" and an "electronics box". The motor box provides a 
junction point between the cables running from the amplifier rack and those running to the 
motors. The electronics box provides junctions for all of the other cables as well as space for 
electronics to filter and amplify the strain gage signals coming from the torque sensors. The 
reason for two boxes was to shield the low level torque sensor signal and electronics from 
the motor power. 

The computer system being used was originally chosen and integrated by Andrew 
Christian, and gratefully, it was his effort that allowed us to get the PHD up and running 
relatively quickly. The base of the computer control system is a VMEbus card cage housing 
several boards including: a system controller, three single board processors, a digital to 
analog converter board, two analog to digital converter boards, six optical encoder reading 
cards, a digital I/O board and extra memory. The backplane of the VMEbus is tied directly to 
the backplane of a Sun 3/180 Workstation. This is a Unix based workstation used for 
software development, compilation, and down loading to the processors. All real time 
control is executed through the VME box. More detailed descriptions of the layout and 
capabilities of this system are given by Christian [3]. 

3.4.1 Cabling/Wiring 

A potpourri of cables are needed to get all the signals back and forth from the robot 
and the racks. There are 5 cables running from the computer rack to the junction boxes, three 
of them are encoder/tach cables and the other two carry the torque sensor signals. Four 
cables run from the amplifier rack to the junction boxes, three of them are motor power and 
the other carries power for the torque sensors. In total, there are 11 cables running from the 
junction boxes to the robot. Each joint has an encoder cable, a motor power cable, and a 
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torque sensor cable. Then the first two joints also have another cable carrying the limit 
switch and tachometer signals. Since the wrist has no tach or limit switches, its connection is 
used for two limit switches on the edge of the base platform, to keep the robot from hitting 
the user in the back of the head. Another cable carries the limit switch signals from the motor 
box to the electronics box. Finally, there is one other cable taking the signal from the extra 
encoder on the shoulder direcdy back to the computer rack. The details of all of these cables 
as well as an overall wiring layout are presented in Appendix C. 

3.4.2 Junction Boxes 

Two junction boxes were required to re-route the signals coming from the racks to the 
various sensors. Additionally, they provide electronics for amplification for the strain gage 
signals near to the robot, so that the low level signal is not required to travel over large 
distances. One other purpose for the junction boxes is to provide a good location for other 
"fixes" that became necessary, such as "pull-up" resistors used to improve the encoder 
signals and a voltage divider used to keep the tach signals within the range of the A/D 
converters. Wiring diagrams for these boxes are also presented in Appendix C. 

3.4.3 Software 

The low level software system which handles board setup and communication for us 
is the Condor system, a computational architecture and programming environment developed 
at the MIT Artificial Intelligence Laboratory. The system was developed primarily by two 
graduate students, Sundar Narasimhan and David Siegel [11,12,13]. Condor provides 
convenient subroutines for handling inter-board communications as well as communication 
between the Sun computer and the VMEbus. It also has standard frameworks for building 
timed, interrupt driven servo loops running at user specified rates. The interface between the 
Sun and VME systems is done by a related program called Xcondor, which allows the user 
to send commands direcdy to the processor boards and monitor their actions. The effect of 
the Condor system is to separate the user from having to deal with issues such as getting the 
various boards to communicate properly and being able to communicate with them. 

The program used to run the PHD is run on two of our three processors. The code is 
written in C and then compiled and downloaded to the boards using the Condor system. The 
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main processor handles the I/O from the Sun and generates commands for the joints. The 
commands take the form of a series of joint angle setpoints which are then used in the servo 
controller. The other board is the servo board which runs the servo loop, sampling all the 
sensors, generating a command and saving the current system status at each step. The 
current control strategy is a simple PD loop on the shoulder and elbow and just proportional 
control on the wrist. The fastest this loop can currently run the three joints is about 500 Hz 
but this can be improved if all the sensor data is not needed (such as in force control). 
Alternatively, the third processor could be used to speed up the control loop. Future research 
will focus on building a better control strategy or implementing some form of joint torque 
control using this system. 


52 


Chapter 4: Experimental Results 


This chapter discusses the results of the experiments that have been performed using 
the PHD robot This includes experiments to identify the important characteristics and 
capabilities of the system, and then tests to determine and verify an acceptable model of the 
Harmonic Drive gear reducer. 


4.1 Capabilities 

One of the first things we wanted to do with the PHD after we got it running was to 
determine a few of its important performance characteristics. We ran some simple tests and 
Table 4.1 shows some of the measured capabilities of the robot. 
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Capabilities of the PHD Robot 

Servoed D.O.F: 

3 

Max. Reach: 

28.4 in. 

Weight: 

500 lb 

Max. Shoulder Slew Rate: 

130 °/sec 

Max. Elbow Slew Rate: 

145 °/sec 

Max. Wrist Slew Rate: 

450 °/sec 

Max. Tip Speed (at full extension): 

90in/sec 

Max. Shoulder Acceleration: 

450 °/sec 2 

Max. Elbow Acceleration: 

975 °/sec 2 

Max. Wrist Acceleration (no end effector): 

15,600 °/sec 2 

Max. Tip Acceleration (at full extension): 

1392 in/sec 2 


Table 4.1 PHD Capabilities 

The main factor limiting the slew rates of the joints is the top motor speed, which is 
limited by our amplifiers. The maximum speed the amplifier is capable of driving the motor 
is 3600 RPM for the shoulder and elbow and 6000 RPM for the wrist, although the 
maximum speeds quoted in the motor product literature is 6000 RPM for the shoulder and 
elbow and 8000 RPM for the wrist. This is predominantly limited by the amplifier current 
and voltage limits which allow a maximum of 40 Volts and 10 Amps. The maximum 
acceleration and force output are determined by the current limits of the amplifiers. The 
motors are actually capable of taking 25 or 30 amps in order to produce their quoted peak 
torque. 


4.2 Surprises/Problems 

As with any piece of hardware several problems were encountered in getting the robot 
up and running. Some of the more important of these problems are discussed in the 
following sections. 
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4.2.1 Addressed 

One issue that I never appreciated was the wiring of the robot. I learned the hard way 
that this is an issue that is best addressed early in the design process. There are signals for 8 
sensors, 2 limit switches, 2 tachometers and 3 motors running between the junction boxes 
and the joints. I had originally planned to run the cables for the two outer joints inside of the 
links, but as it turned out only the tach/limit switch cables and the torque sensor cables would 
fit. Had I taken the time to think about the required cables, I would have made the links out 
of larger diameter tubing. 

Another problem that came up after the robot was assembled was backlash. After the 
initial assembly there was a slight backlash in the shoulder joint. The cause of this backlash 
was determined to be the Harmonic Drive not being assembled tightly. This means that the 
wave generator was not pressed far enough down into the flexspline to remove all backlash. 
The reason for this is that as the elliptical wave generator is pressed into the round flexspline, 
the flexspline's walls are deflected outward. This causes the flexspline teeth to be pushed out 
against the circular spline teeth, removing all backlash from the drive. The solution for 
removing the backlash in the shoulder was to mount the wave generator further out on the 
motor shaft in order to make the H.D. truly backlash free. Unfortunately, this pointed out 
the importance of mounting the wave generator squarely onto the motor. If the wave 
generator is not square to the shaft, it causes a noticeable ’’bump" in the output as it spins. 
This caused us to have to redesign and re-machine the part holding the wave generator onto 
the motor shaft. 

4.2.2 Unaddressed 

There are a couple of problems that came up which we have not yet had time to 
repair. The first is the bearing preloading, which is not quite even. This causes the joint's 
velocity to vary slightly as it rotates. The cause of this problem is that the rings which 
preload the bearings are hand tightened in 12 places. If you tighten them down all the way it 
produces too much preload in the bearings (and thus too much friction). Therefore, there is a 
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small gap between the ring and the inner cylinder and it is nearly impossible to get an even 
preload. The solution to this problem would be to place a shim under the ring of the proper 
thickness so that the ring could be tightened down hard against it and still remain square. 

Another issue we have yet to address is the servo loop speed. As it stands now we 
can not run our servo any faster than 500 Hertz, and in the future we may need a faster loop. 
The main thing slowing the loop is reading all of the sensors. This consists of having to 
convert 5 Digital to Analog channels (3 for the torque sensors, and 2 for the tachometer) and 
4 encoder channels (two for the shoulder and one each for the elbow and wrist). There is a 
relatively easy fix for this problem, which is already partly underway. We have purchased 
another D/A card and have another microprocessor board. Ideally, the other processor board 
could be used to continuously sample the sensors, then the servo loop could run significantly 
faster. 


4.3 Harmonic Drive Testing 

One of the stated goals of the PHD was to research Harmonic Drive performance 
characteristics. Preliminary research has begun and this section presents the results obtained 
from that testing. It first details the testing already completed and then goes on to propose 
some further areas of interest for expanding and improving the model. Our initial research 
took place using just the shoulder joint of the PHD. To perform all of our tests the elbow 
and wrist joints were removed allowing us to look at the shoulder alone. Some of the 
characteristics of the shoulder Harmonic Drive are given in Table 4.2. 


Model: 

1M 

Ratio: 

160 

Max. Input Speed: 

7000 RPM 

Max. Output Torque: 

2470 in lb 

No-Load Starting Torque (at input): 

11 oz in 

Circular Spline O.D.: 

4.25 in 

Weight: 

2.6 lb 


Table 4.2 Specifications for Shoulder Harmonic Drive 
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4.3.1 Static Testing 

The first area we wanted to examine with regard to the Harmonic Drive was whether 
we could confirm the properties reported in the product literature. This involved testing to 
determine the rotational spring rate for the drive. Our goal was to measure experimentally the 
spring rate from both the input and output sides of the drive. Since both sides of the drive 
were outfitted with optical encoders this process was relatively straight forward. First, we 
looked at the input stiffness. This was done by fastening the output link firmly to the base. 

It was very important to firmly lock the output so that there would be no backlash as it was 
tested. This was accomplished by machining a piece of 1" thick aluminum plate with a slot 
which the link would fit into snugly. This plate was then bolted to the steel base plate the 
robot is mounted on as shown in Figure 4.1. 
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Figure 4.1 Isometric of Input Stiffness Test Setup 

This setup then allowed us to load the Harmonic Drive input using the D.C. motor 
and measure the flex using the encoders. Additionally, the torque sensor provided data as to 
how much torque the drive was seeing. Given the position and torque data we could 
determine the stiffness. A graph showing the torque vs. position for the input is shown in 
Figure 4.2. The position is the equivalent output position (e.g. the motor angle divided by 
160). In Figure 4.3 the same data is shown plotted next to a linear spring approximation 
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with a stiffness of 320,000 in lb/rad, which is our best linear approximation to this data. As 
you can see the Harmonic Drive does have a slight non-linearity—the stiffness increases as 
the torque increases. This effect presumably continues as the torque climbs but we were 
incapable of increasing the input torque to the motor's full capabilities due to current limits on 
the amplifier driving the motor (10 Amps). The motor is capable of delivering 260 in oz at 
peak which would give 2600 in lb at the H.D. output, but this requires an input of 30 Amps. 
We did run some tests with a larger amplifier but ran into difficulties with noise since the 
amplifier was pulse-width modulated. This caused noise in the low level torque signal which 
affected the results considerably. 



Fi gure 4.2 Test Results for Determining Harmonic Drive Input Stiffness 
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Fi gure 4.3 Tested H.D. Input Stiffness with Linear Approximation to Data 

Shown in Figure 4.4 is the input stiffness plotted against the stiffness quoted in the 
H.D. literature. The quoted stiffness is 250,000 in lb/rad up to 20% of the rated torque (at 
1750 RPM) and then it jumps to 515,000 in lb/rad. It can be seen that for low torques this 
approximation isn’t too bad but for higher torque the results do diverge. There are several 
possible explanations for this discrepancy. The first is that the H.D. we have has a slightly 
different spring rate. Another is that the actual torque was higher than what we measured. 
This difference could possibly be due to some inefficiency in the drive, although this seems 
unlikely since the drive was not moving very quickly (0 to 0.002 radians and back in 20 
seconds). 


60 



































Chapter 4: Experimental Results 



0 .0002 .0004 .0006 .0008 .001 .0012 .0014 .0016 .0018 .002 

Position (rads) 

Figure 4.4 Tested H.D. Input Stiffness with Factory Quoted Stiffness 
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Fi gure 4.5 Isometric of Output Stiffness Test Setup 

The second static test we ran was to determine the stiffness from the output as shown 
in Figure 4.5. To do this, we removed the motor and replaced it with a part which locked the 
H.D. wave generator to the top plate. Then a spring scale was used to pull on the end of the 
link and apply a torque on the joint. The data for this is test graphed along with a spring rate 
approximation of 265,000 in lb/rad in Figure 4.6. Again, the linear approximation is the best 
fit to the available data. The steps in the data are due to the output encoder, which has a 
resolution of 0.0000785 radians per count. As you can see, the data again shows a 
pronounced non-linearity, stiffening as the torque increases. Figure 4.7 shows the output 
stiffness compared again to that reported in the company literature. In this case the measured 
stiffness is somewhat less than that given by the company. 
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0 .0003 .0006 .0009 .0012 .0015 .0018 .0021 .0024 .0027 

Position (rads) 

Fi gure 4.6 Tested H.D. Output Stiffness with Linear Approximation to Data 
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Figure 4.7 Tested H.D. Output Stiffness with Factory Quoted Stiffness 


Another interesting result that we noticed was that the drive is slightly stiffer in 
counterclockwise direction than it is in the clockwise direction. Table 4.3 shows the average 
linear spring stiffnesses we measured for different tests of the Harmonic Drive. We were not 
surprised to find a difference between the input and output stiffnesses, as the mechanism of 
running the drive forward and backward are significantly different. The slight change in 
stiffness dependent on direction is a much more interesting effect. We have not yet been able 
to pin down the cause of this, but we feel it must be within the H.D. since it happens on both 
the input and output sides. 


Directional Stiffnesses 

Clockwise 

Counterclockwise 

Input 

290000 in lb/rad 

330000 in IbAad 

Output 

280000 in lb/rad 

300000 in lb/rad 


Ta b l e d Tested Harmonic Drive Stiffnesses for Shoulder Joint 


64 























Chapter 4: Experimental Results 


4.3.2 Theoretical Model 



Fi gure 4.8 Schematic of Model 

Based on the tested stiffnesses, we decided that the next thing we wanted to do was 
construct a simple model of the drive and test its validity. The simplest model is that of a 
linear, rotational spring connecting two inertias, one being the joint and load inertia and the 
other being the motor inertia reflected through the gear ratio. A schematic of this model is 
illustrated in Figure 4.8. Basically, this model represents the motor driving the shoulder, 
with a load mounted at the end of the first link as shown in Figure 4.9. 
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Figure 4.10 Schematic of Model 


Analyzing this model, we wish to determine the natural frequency, which can be 
calculated in a number of ways. We chose to use the inherent symmetry, by noting that there 
is some point on the spring which remains still as the two inertias vibrate as illustrated in 
Figure 4.10. The spring can then be divided into two stiffnesses, ki and k 2 , which must 
yield the overall spring constant, k, according to the following equation 


1 

k 



(4.1) 


Since both sides must vibrate at the same frequency we know 



(4.2) 


where Ji and J 2 are the load and equivalent motor inertias, respectively. Since we also know 
k for the H.D. we can then solve to find 




(4.3) 


For the PHD this test was run with a 6.25 lb load mounted where the elbow would usually 
be, so the parameters are: 


Jl = 160 2 (2.6 x 10"5) ft lb s^ 
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J 2 = 0.2267 ft lb s2 

The stiffness we measured for the shoulder joint was 

k = 300,000 in lb/rad = 25,000 ft lb/rad 
so we get a predicted natural frequency of 

C0n = 384.5 rad/s = 61 Hertz 

4.3.3 Experimental Results 

The next step was to try to experimentally prove that the shoulder would resonate at 
this frequency. We began by performing a sine sweep using the control system, by inputting 
sine waves of varying frequencies to the motor and looking at the motor and output 
positions. From this information we could then derive the necessary magnitude and phase 
information to construct a Bode plot. Unfortunately, since the frequency we were looking 
for was so high it was difficult to get good data. Due to the limits of the motor and amplifier 
pair, we could only achieve a servo bandwidth of around 40 Hertz using this method. Above 
this frequency we could not take useful data. 

To alleviate this problem we obtained a Hewlett Packard Spectrum Analyzer. This 
allowed us to analyze the frequency response of the shoulder without having to worry about 
amplifier limits or servo loop bandwidth. The analyzer generates a white noise signal and 
then, based on a feedback signal and that noise, determines the frequency response of a 
system. In testing the PHD, we took the white noise signal and ran it into the amplifier as the 
current command. Then we fed back either the tachometer or torque sensor signal depending 
on whether we wanted to look at the input or output side of the H.D. 
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TRANS 20 



Fi gure 4.11 Bode Plot of System Response with Load 

Figure 4.11 shows a Bode plot taken of the shoulder with the load inertia mounted. 
The values on vertical scale on this plot are not relevant, these plots were used only to 
determine where peaks occurred. The horizontal scale tick marks are located at 0.5,1,5,10 
and 50 Henz, which is not clear in the plot. From the data you can see there is a peak in the 
magnitude plot at 50 Hz, which is slightly lower than the predicted frequency 61 Hz peak for 
the mode between the motor and load inertia. There are several probable reasons for this 
difference. First, our calculation considered only the flexibility in the H.D., and not any in 
the link or joint Although we designed all the other elements to be much stiffer than the 
H.D. they will still have some effect on lowering the frequency of this mode. Second, the 
white noise did not generate very large motions in the joint, so the H.D. was operating in the 
range where its stiffness is lowest Our stiffness estimate was an average for the whole 
range of tested torques. If we examine the plot again and just use the initial slope we get a 
spring rate of about 255,000 in lb/rad. This corresponds to a natural frequency of 56 Hz 
which is closer to the measured frequency. 
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TRANS #A: 20 



500.00 m LG HZ 50.000 


Figure 4.12 Bode Plot of Motor Response with Load 

Shown in Figure 4.12 is a Bode plot of the transfer function between the motor 
(actually the amplifier) and the tachometer. As you can see the response just rolls off at 20 
dB/decade with a small resonance at 50 Hz which is due to the resonance of the load inertia. 
This means that the motor/amplifier pair essentially looks like an integrator which is what we 
would expect from Newton's Third Law 

T motor = J « = J S CD (4.4) 


or 


co _ f 

T s 

motor 


(4.5) 
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TRANS #A: 20 



0.0 HZ 100.00 

Fi yure 4.13 Bode Plot of System Response without Load 

The next test we performed was to remove the load inertia to check if the joint had a 
flat response and, as shown in Figure 4.13, there are no surprises. One final set of tests we 
wanted to run was to look at the response with the output locked. If the simple spring model 
is valid we would expect a simple second order response from this test. Figure 4.14 shows 
the result and it does, to a large degree, look like a second order response. There are some 
other effects but the spring model predicts the behavior reasonable well. 
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TRANS 20 



500.00 m LG HZ 50.000 


Figure 4.14 Bode Plot of System Response with Output Locked 
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4.3.4 Model Weaknesses/Improvements 



Figure 4.15 Position Data for a Low Speed Move 

There are still some effects that are not predicted by the simple linear spring model of 
the H.D. Figure 4.15 shows a plot of the shoulder position for a slow move of the joint. 
Although it looks smooth on this plot if you draw a parallel line next to it and subtract the 
data from that line you get the plot shown in Figure 4.16. As you can see there are definitely 
some higher order effects going on here. The large scale variation is due to velocity 
changing, which is caused by unequal bearing preloading. The frequency of the small wave 
is the same as that of the motor and wave generator. This effect seems likely to be caused by 
the Harmonic Drive and it is obviously not something predicted by our simple spring model. 
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In order to build a model to predict effects such as this we would have to build a more 
detailed model of the interactions of the three parts of the drive. 



Fi gure 4.16 Modified Data for a Low Speed Move 
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Two main areas of research have been addressed, the modeling of complex systems 
to produce accurate simulations, and the design and construction of a robot for the testing of 
torque control and Harmonic Drive performance. The main conclusions of this research are 
outlined in the following chapter. 

In trying to build a good simulation model there are several items which must be 
carefully considered. The most important issue is what the model will be used for. The main 
goal of our model of the RRC arm was to provide simulation data which could accurately 
predict robot motions while running in a position control mode. We found that a simple 
linear model was inadequate for this system, since it predicted that some of the joints would 
be unstable. A more detailed non-linear model, which included Coulomb friction in the 
motor and joints and a non-linear model of the Harmonic Drive spring rate, provided better 
results. 


An experimental test plan was designed and the results compared favorably to the 
simulation predictions. Parameter studies suggested possible areas where our model could 
be improved. One interesting result of these studies was that although it was important to 
include the non-linear friction effects to get a stable simulation, the values used for the 
Coulomb friction did not affect the results significantly, even when changed by up to an 
order of magnitude. Finally, the feasibility of using our position control model for force 
control was examined and it was found that the model’s ability to predict such quantities as 
joint torque and motor current was inadequate. Some improvements had to be made in the 
model to in order to predict these quantities. The most important of these was adding the 
effects of current and voltage limits in the motor amplifier. 
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The next part of the research was to design and build a planar, three degree of 
freedom robot, the PHD, which could be used to study two areas. The primary goal was to 
be able to evaluate different torque control schemes. Additionally, we wanted to use the 
robot to determine a suitable dynamic model of the Harmonic Drive gear reducer. The robot 
was designed with both of these goals in mind. It consists of three planar rotary joints, 
shoulder, elbow and wrist. The shoulder is mounted to the base and drives the first link, 
which connects to the elbow. The elbow drives the second link which connects to the wrist, 
which has a continuously rotating output that serves as the mounting point for any end 
effector. 

The drivetrain for each joint of the robot consists of a D.C. servo motor driving a 
Harmonic Drive gear reducer. There is also a torque sensor mounted in each joint to allow 
measurement of the torque across the joint. Position feedback is available on all three joints 
and velocity information is available on the shoulder and elbow. Additionally, there is an 
encoder mounted on the output of the shoulder to allow direct measurement of the shoulder 
position. This allows us to look at both the input and output positions of the Harmonic 
Drive, as well as the torque transmitted through it (using the torque sensor). All of this 
information allows us to examine the Harmonic Drive more closely to determine its important 
dynamic characteristics. 

Experiments were then conducted to verify the robot's capabilities. The limiting 
factor in terms of the PHD's performance was found to be the amplifiers which drive the 
motors, and more powerful amplifiers would allow improved robot performance. The next 
experiments concentrated on determining the static properties of the Harmonic Drive, 
specifically the spring rate, quoted to be piece-wise linear in the product literature. We 
indeed found that the drive stiffened as the load was increased although we found our 
stiffnesses to be slightly lower. We also found that the measured stiffness was slightly 
different when measured from the input and the output. Although this was not an expected 
result, it is not surprising since the input and output mechanisms of the drive are significantly 
different. 

Next, we moved to test how well a simple linear model of the drive would predict 
actual performance. To test this, the elbow and wrist joints were removed from the robot and 
a load inertia was added at the end of the first link. Using the linear spring model, the 
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predicted natural frequency of this system was estimated to be 61 Hertz. Our tests showed 
the actual resonance was closer to 50 Hertz. The discrepancy was attributed to the fact that 
the model took into account only the flexibility in the Harmonic Drive. It is apparent that 
there are other elements contributing flexibility to the system, such as bending in the link. 

In conclusion, it was shown that the linear spring provided a fairly good model of the 
Harmonic Drive and could be used as a good first cut model for the drive's flexibility. The 
data also shows that there are other noticeable effects present in the drive whose prediction 
would require a more detailed model of the drive. Fortunately, these effects are small when 
compared to the overall joint motion. At this point we have only begun to explore the 
possible uses of this robot. 

The PHD does possess the ability for testing and development of torque control 
strategies. These strategies may provide an area for the advancement of the abilities of force 
control, by allowing torque control to be implemented on a one, two or three degree of 
freedom arm. The modularity and capabilities of the PHD's design will hopefully provide a 
valuable tool for further research in this area. Using all three joints, the PHD can accomplish 
simple tasks such as planar peg in hole. Additionally, future work with the PHD can allow 
development of a more detailed model of the Harmonic Drive which would predict the higher 
order effects present in the drive. 
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Appendix A: Torque Sensor Specifications 


This appendix contains detailed information on the torque sensors we designed and 
built for the PHD. This includes: engineering drawings, a table of pertinent specifications 
and calibration curves for each sensor. 


A.l Shoulder 

The shoulder torque sensor is a relatively simple design consisting of a cylinder 
which is bolted between the bottom of the Harmonic Drive flexspline and the base plate for 
the joint. As the torque through the joint is increased, the sensor strains, causing the strain 
gages on its surface to produce a voltage change proportional to the torque. The measured 
conversion from counts to inch-pounds for this sensor is given in Table A.l. This was 
measured while the A/D gain was set for a ±2.5 V range. 
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Fi gure A.l Shoulder Torque Sensor Engineering Drawing 



Stiffness (Theoretical): 

3.88 x 106 in lb/rad 

Torque to A/D Count Conversion*: 

0.441 in lb/count 


Number of Gages: 


Type of Gage: 

Micro Measurements 

CEA-13-187UV-350 

Gage Factor, y: 

2 

Max. Torque (limited by motor): 

2600 in lb 

Max. Output Voltage (before amplification): 

4.41 mV 

Max. Strain: 

2.41 x 10- 4 in/in 

Max. Stress: 

1807 psi 
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Figure A.2 Calibration Curve for Shoulder Torque Sensor 
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A.2 Elbow 

The elbow torque sensor is nearly the same as the shoulder except it is slightly 
smaller. The measured conversion from counts to inch-pounds is given in Table A.2. This 
was measured while the A/D gain was set for a ±2.5 V range. 



Figure A.3 Elbow Torque Sensor Engineering Drawing 
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Appendix A: Torque Sensor Specifications 


Stiffness (Theoretical): 

1.63 x 10^ in lb/rad 

Torque to A/D Count Conversion*: 

0.246 in lb/count 

Number of Gages: 

4 

Type of Gage: 

Micro Measurements 

CEA-13-187UV-350 

Gage Factor, y 

2 

Max. Torque (limited by motor): 

1300 in lb 

Max. Output Voltage (before amplification): 

4.16 mV 

Max. Strain: 

2.08 x 10- 4 in/in 

Max. Stress: 

1564 psi 


Table A.2 Specifications for Elbow Torque Sensor 
♦This is with the A/D set at ±2.5 Volts 



Figure A.4 Calibration Curve for Elbow Torque Sensor 
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Appendix A: Torque Sensor Specifications 


A.3 Wrist 

The wrist torque sensor is very different from the other two. This is because to 
obtain enough strain with a cylindrical design the walls would have had to be very thin (or 
the sensor s diameter would have had to be very large). To alleviate this problem we chose 
to totally remove the wall in 6 places leaving 6 equally spaced posts which would carry the 
torque. The four gages mounted on this sensor are not at 90° increments along the surface 
but on four of the six posts. The measured conversion from counts to inch-pounds is given 
in Table A.3. This was measured while the A/D gain was set for a ±2.5 V range. The 
reason for the jumps in the calibration curve is that we did not load the sensor very much, so 
that we were working down near the resolution of the D/A, and electrical noise caused jumps 
in the data. 



Figure A.5 Wrist Torque Sensor Engineering Drawing 
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Stiffness (Theoretical): 

3.70 x 10 5 in lb /rad 

Torque to A/D Count Conversion*: 

0.185 in lb/count 

Number of Gages: 

4 

Type of Gage: 

Micro Measurements 
CEA-13-187UV-350 

Gage Factor, j. 

2 

Max. Torque (limited by motor): 

125 in lb 

Max. Output Voltage (before amplification): 

6.76 mV 

Max. Strain: 

3.38 x 10 -4 in/in 

Max. Stress: 

642 psi 


Table A.3 Specifications for Wrist Torque Sensor 
*This is with the A/D set at ±2.5 Volts 



figure At(? Calibration Curve for Wrist Torque Sensor 





Appendix B: Hardware Specifications 


This appendix is broken into three sections. The first gives maintenance and safety 
information for the robot. The second gives pointers on the assembly of the robot and its 
joints. Finally, the third contains a list of all of the hardware used in the PHD robot 

B.l Maintenance/Safety 

This section outlines some important points that must be remembered when operating the 
PHD in order to prevent wear and accidents: 

• Always keep the emergency stop switch within reach when the robot is running. 

• Always make sure the work envelope is clear of obstacles before enabling the 
amplifiers. 

• Always make sure all the limit switches are in place and operating properly. 

• Be careful when working in the electronics box, the strain gage power is always on, 
even when power to the amplifier rack is turned off. 

• Before running make sure all cables are firmly attached, especially motor cables. 

• All joints should be checked periodically for loose bolts. 

• Re-grease the Harmonic Drive gear teeth whenever the joints are disassembled. 

• Periodically check all cables for wear, especially bending fatigue. 
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B.2 Assembly 

This section gives instructions for the assembly of each of the joints as well as the 
overall robot. I assume that anyone can get the robot apart, so this section details how to get 
it back together. It begins with assembly of the shoulder and elbow, followed by the wrist. 
Finally, the assembly of the three joints to the links, along with cable routing is discussed. 

B.2.1 Shoulder and Elbow Assembly 

Since the shoulder and elbow joints are basically the same, the same assembly 
procedure applies to both. The joint is assembled in two parts, the joint housing and the 
drivetrain, which are then bolted together to produce the assembled joint. 

First, the joint housing must be assembled. This is begun by putting the bearings 
into the outer tube separated by the bearing spacer ring. It may be necessary to heat the outer 
tube to get the bearings in. They are angular contact bearings, so you must be careful to 
install them correctly (back to back). Next, the base plate should be bolted to the inner tube 
and this assembly should be slid into the outer tube. (On the shoulder, the large gear and 
gear cover should be mounted before putting this base plate on.) Then the inner tube top 
plate should be mounted. IMPORTANT : Do not tighten the inner tube top plate down all the 
way or it will overload the bearings. It must just be tightened until snug (all bearing play is 
removed). Ideally, a shim of the proper thickness should be placed under the top plate to 
guarantee it is squarely mounted. If it is tightened unevenly, the bearings will exhibit varying 
friction as they spin. Next, the outer tube top plate should be bolted on. This completes the 
assembly of the joint housing. 

Now the drivetrain must be assembled. First, check that there is still grease on the 
Harmonic Drive teeth. If most of it is gone, re-apply some more grease (H.D. calls for a 
NGLI #2 grease). Mount the motor adapter plate to the motor. Then the H.D. wave 
generator must be mounted on the motor shaft using the TranTorque coupling. It is 
important to mount the wave generator as far out on the shaft as possible, especially on the 
shoulder, as mounting it too close to the motor will not provide proper tooth preloading in the 
Harmonic Drive, resulting in a small amount of backlash in the output Next, take the torque 
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sensor and bolt it to the H.D. flexspline. The concentricity of these two pieces must be 
checked. Since there is no locating mechanism, it must be adjusted by hand (by feeling or 
looking at the center holes to see how well they match up). If they are off, loosen and re¬ 
align them. Next, slide the flexspline onto the wave generator. Then, slide the circular 
spline on over the torque sensor and flexspline. To check that the H.D. has been assembled 
properly the motor can be turned by hand. This can be done by pulling off the encoder cover 
and carefully turning the motor shaft, as the circular spline is held to the motor adapter plate 
by hand. If assembled properly the flexspline should deflect twice per motor revolution. If it 
is only deflecting once, you have assembled the H.D. dedoidally and must remove the 
circular spline and try again. 

Now the drive train can be slid into the joint housing. Be careful not to mangle the 
torque sensor wires. The torque sensor cable connector must slide through the hole in the 
base plate, and it is important to verify that the wires from the gages go through the slot on 
the bottom of the sensor before bolting the drivetrain on. This can be done by rotating the 
whole drivetrain until the slot (and hopefully wires) are seen through one of the bolt holes in 
the base plate. After this the torque sensor can be bolted down, be sure to tighten the bolts a 
bit at a time, not all at once as the sensor could then get misaligned in the joint housing. 
Finally, the motor plate and circular spline must be bolted to the top of the joint housing. At 
this point it is worth taking off the encoder cover and rotating the motor by hand to verify 
everything is together properly and the joint turns. 

B.2.2 Wrist Assembly 

Assembly of the joint housing is identical to the other two joints above except that 
only eight of the holes on the outer tube top plate are used to hold it down, the other eight are 
to hold the torque sensor. The drivetrain assembly is as follows. First bolt the motor adapter 
plate to the motor. Then the H.D. wave generator is affixed to the motor shaft using Loctite. 
Again, it is important to make sure the wave generator is far enough out on the motor shaft. 
Next, bolt the H.D./Output Adapter to the H.D. flexspline and slide the flexspline over the 
wave generator. Now the circular spline must be bolted to the torque sensor on the inside. 
You will notice that this only uses six of twelve holes on the bolt circle. Next, slide the 
torque sensor and circular spline over the flexspline and bolt them together using the other six 
holes. At this point you must again check to see that the Harmonic Drive has not been 
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assembled dedoidally. If so remove the circular spline and try again. Now slide the 
drivetrain into the joint housing and bolt the output plate to the bottom of the H.D ./Output 
Adapter. Then, the torque sensor can be bolted down using the other eight holes on the top 
of the outer tube. Before doing this it is important to make sure the cables are properly 
oriented, so that the encoder and torque sensor cables will be pointing in the right direction 
when the joint is fully assembled. Finally, the torque sensor cover can be placed over the 
sensor and bolted down. Be careful not to damage the torque sensor wires. 


B.2.3 Joint/Link Assembly and Wiring 

The first step in this process is to take the assembled shoulder joint and mount it to 
the table. This is done using the "special" Allen wrench, an Allen wrench that has been 
shortened to fit under the gear. (This is the major flaw in the design which I would change if 
I had another chance by making the base 8" in diameter.) After that the extra encoder must be 
mounted. (This process is the other flaw in my design.) You must use either another 
"special" Allen wrench or a pair of needle nose pliers to tighten the two bolts holding the 
encoder mounting plate on. Make sure that the anti-backlash gear is preloaded before 
meshing the two gears. The rest of the assembly is straight forward (no more "special" 
tools). First, stuff the elbow and wrist torque sensor cables and elbow tach/limit switch 
cable through the first link (the shorter one). Make sure the right ends are through and bolt 
the first link onto the shoulder output. (Important note: there is a drop of epoxy on this link 
on the edge of one of the ends. This drop must be on the top of the elbow side of the link. It 
is what triggers the limit switch on the elbow.) Now bolt the elbow to the link, the elbow 
attaches on the lower mounting spot (on the inner tube so that the second link is above the 
first). Now run the wrist torque sensor cable through the second link and bolt it to the elbow 
(it doesn’t matter which way) and bolt the wrist to its end. That completes the mechanical 
assembly. 

Now the rest of the cabling must be finished. The torque sensor and tach/limit switch 
cables should be attached first. Then the encoder and motor cables which are routed down 
the outside of the links. Make sure you leave enough slack in the cables at the elbow to allow 
them to wrap all the way around. If you use wire ties creatively you can get this slack to stay 
up off the table when the joint is straightened. This completes the robot assembly, although 
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it is probably a good idea to check the cables are wired properly one more time before firing 
the robot up. 

B.3 Hardware Parts List 

This section gives a list of each piece of hardware purchased and the manufacturer. 

B.3.1 Shoulder 


Motor 

Aerotech 1035DC-01 Servo Motor 

Harmonic Drive: 

Harmonic Drive HDC-1M-160-2-K1 

Bearings: 

Kaydon KA040ARO (angular contact) 

Motor Encoder 

HEDS-6000 Option B08 (1000 lines/rev) 

Strain Gages: 

Micro Measurements CEA-13-187UV-350 

Strain Gage Signal Conditioner: 

Analog Devices Model 1B31-AN 

Output Encoder: 

Vemitech VOEL-23-2500-AQ1-PU5-1L1 
(2500 counts/rev) 


B.3.2 Elbow 


Motor 


Aerotech 1017DC-01 Servo Motor 


Harmonic Drive: 


Harmonic Drive HDC-5C-160-2-K1 


Bearings: 


Kaydon KA030ARQ (angular contact) 


Encoder: 


HEDS-6000 Option B08 (1000 lines/rev) 


Strain Gages: 


Micro Measurements CEA-13-187UV-350 


Strain Gage Signal Conditioner: Analog Devices Model 1B31-AN 
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B.3.3 Wrist 




Harmonic Drive: 


Bearings:_ 


Encoder:_ 


Strain Gages: 


Strain Gage Signal Conditioner: 


Stray Clifton from A.I. Lab Supply 
(similar to Clifton SmCo AS-780D Series) 
Harmonic Drive HDC-1C-80-2-K1 
Kaydon KA020ARQ (angular contact) 
HEPS-5000 Option A06 (500 lines/rev) 
Micro Measurements CEA-13-187UV-350 
Analog Devices Model 1B31-AN 
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Appendix C: Wiring Details 


This appendix details the wiring of the PHD. It is broken down into two sections: the 
pinouts for all of the cables and the wiring for the two junction boxes. There are 22 cables, 5 
from the computer rack to the junction boxes, 4 from the amplifier rack to the boxes, 1 from 
the computer rack to the robot, 1 between the two junction boxes and 11 from the junction 
boxes to the robot 

C.l Cables 


This section gives the pinouts at either end of each of the cables on the PHD. The 
number after the cable name tells how many of these cables there are. One note, on any cable 
where we weren't sure whether we needed the shield we connected a small black wire to it 
which runs out the back of the connector housing. This can then be hooked up if noise 
becomes a problem. 
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Encoder Cables (3) 

Purpose: Take encoder and tachometer signals from Junction Box to Computer, one for 

each joint 

Wire used: Low impedance cable with 6 twisted, shielded pairs 
Notes: Shield wires ground to connector housing on computer end 


Pinouts: 

Computer End: _ Male DB-15 


Pin# 

Function 

1 

A/D Low 

2 

A/D Ground 

3 

N.C 

4 

N.C 

5 

Encoder +5 V 

6 

Encoder Index 

7 

Encoder B 

8 

Encoder A 

9 

A/D High 

10 

Digital I/O Ground 

11 

N.C. 

12 

Encoder Ground 

13 

Not Used 

14 

Not Used 

15 

Not Used 


Box End: Female DB-15 


Pin # 

Function 

1 

A/D Low 

2 

A/D Ground 

3 

N.C 

4 

N.C 

5 

Encoder +5 V 

6 

Encoder Index 

7 

Encoder B 

8 

Encoder A 

9 

A/D High 

10 

Digital I/O Ground 

11 

N.C. 

12 

Encoder Ground 

13 

Not Used 

14 

Not Used 

15 

Not Used 
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A/D Cables (2) 


Purpose: Take torque sensor signals from Junction Box to Computer, one (1) for 

shoulder and elbow and one (2) for wrist (with extra A/D not used) 


Wire used: Two cables, each with one twisted, shielded pair 


Notes: Shield wires stick out back of connector housing on computer end 


Pinouts: 

Computer End: _ Male DB-15 


Pin# 

Function 

l 

N.C. 

2 

N.C. 

3 

N.C 

4 

N.C 

5 

N.C. 

6 

A/D Ground 

7 

1 st Channel High 

8 

2 nd Channel High 

9 

N.C. 

10 

N.C. 

11 

N.C. 

12 

N.C. 

13 

N.C. 

14 

1 st Channel Low 

15 

2 nd Channel Low 


Box End: 

Female DB-9 

Pin # 

Function 

1 

1 st Channel High 

2 

2 nd Channel High 

3 

N.C 

4 

N.C 

5 

N.C 

6 

1 st Channel Low 

7 

2 nd Channel Low 

8 

N.C 

9 

N.C 
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Motor Power Cables (3) 

Purpose: Take motor power and limit switch signals from Motor Box to Amplifier 

Rack, one for each joint 

Wire used: Two cables, one large gage for motor (white) and one small gage for limit 
switches (grey) both are twisted, shielded pairs 

Notes: Shield wires on limit switch cables are floating 

Pinouts: 

Amp Rack End: Male DB-25 Motor Box End: Female DB-15 


Pin# 

Function 

1 

Motor Cable Shield 

2 

Motor Power 

3 

Motor Power 

4 

Motor Power 

5 

Motor Power 

6 

Motor Power 

7 

Motor Power 

8 

Limit Switch 

9-13 

N.C. 

14 

Motor Ground 

15 

Motor Ground 

16 

Motor Ground 

17 

Motor Ground 

18 

Motor Ground 

19 

Motor Ground 

20 

Limit Switch 

21-25 

N.C. 


Pin# 

Function 

1 

Motor Power 

2 

Motor Power 

3 

Motor Power 

4 

Motor Power 

5 

Motor Power 

6 

Motor Power 

7 

Motor Power 

8 

Limit Switch 

9 

Motor Ground 

10 

Motor Ground 

11 

Motor Ground 

12 

Motor Ground 

13 

Motor Ground 

14 

Motor Ground 

15 

Limit Switch 
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Strain Gage Power Cable (1) 

Purpose: Supply power to strain gage chips from supply located in amplifier rack 

Wire used: Low impedance cable with three twisted shielded pairs 

Pinouts: 

Amp Rack End: Male 5 Pin Box End: Female 5 Pin 


Pin# 

Function 

A 

+15V 

B 

Ground 

D 

-15V 

E 

Shield 

H 

Unused 


Pin# 

Function 

A 

+15V 

B 

Ground 

D 

-15V 

E 

Shield 

H 

Unused 


Limit Switch Jumper Cable (1) 


Pur pose: Take limit switch signals from junction box to motor power box 

Wire used: Low impedance cable with three twisted shielded pairs 


Pinouts: 

Box End: 

Female 7 Pin 

Pin# 

Function 

A 

Shoulder Limit Switch 

B 

Shoulder Limit Switch 

C 

Elbow Limit Switch 

D 

Elbow Limit Switch 

E 

Wrist Limit Switch 

F 

Wrist Limit Switch 

H 

Shield 


Motor Box End: Male 7 Pin 


Pin# 

Function 

A 

Shoulder Limit Switch 

B 

Shoulder Limit Switch 

C 

Elbow Limit Switch 

D 

Elbow Limit Switch 

E 

Wrist Limit Switch 

F 

Wrist Limit Switch 

H 

Shield 
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Take encoder signals from motor to Junction Box, one for each joint 
Shielded ribbon cable 

Shield of cable sticks out of jacket on junction box end, it is not connected to 
anything right now 


Robot Encoder Cables (3) 

Purpose: 

Wire used: 

Notes: 


Pinouts: 

Box End: Male DB-9 


Pin# 

Function 

l 

Encoder Index 

2 

Encoder B 

3 

Encoder Ground 

4 

Encoder Ground 

5 

Encoder A 

6 

Encoder +5 V 

7 

Encoder +5 V 

8 

N.C. 


Encoder +5 V 


Robot End: Male 10 Pin 


Pin# 

Function 

l 

Encoder A 

2 

Encoder +5V 

3 

Encoder Ground 

4 

N.C. 

5 

N.C. 

6 

Encoder Ground 

7 

Encoder +5 V 

8 

Encoder B 

9 

Encoder +5 V 

10 

Encoder Index 


Robot Motor Power Cables (3) 

Pur pose: Take motor power from Motor Box to motors, one for each joint 

Wire used: Shielded 3 conductor 14 gage cable 
Pinouts: 


Color 

Function 

Red 

+ Motor Power 

Blue 

Motor Ground 

Yellow 

Shield (only on box end) 
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Robot Tach/Limit Switch Cables (2) 

Purpose: Take tach and limit switch signals from joint to Junction Box, one for 

shoulder, one for elbow 

Wire used: Two, two conductor cables, each with one twisted shielded pair 

Notes: There in no cable running to the wrist since there is no tach or limit switches 

(limit switches could be added). Instead, the connection at the box end is 
where the limit switches on the table are connected. Shield of cable sticks out 
of jacket on junction box end, it is not connected to anything right now 


Pinouts: 
Box End: 


Female 4 Pin 


Pin # 

Function 

A 

Tachometer 

B 

Tachometer 

C 

Limit Switch 

D 

Limit Switch 


Robot End: 


Pin# 



Male 4 Pin 


Function 


Tachometer 


Tachometer 


Limit Switch 


Limit Switch 


Robot Torque Sensor Cables (3) 


Purpose: Take power and signal between torque sensors and Junction Box, one for 

each joint 

Wire used: Two, two conductor cables, each with one twisted shielded pair 

Notes : Shield of cable sticks nut of iflckf»* on innptinn k/w it to f1At OAflMAnfA/1 


Shield of cable sticks out of jacket on junction box end, it is not connected to 
anything right now 


Pinouts: 
Box End: 

Pin# 

A 

B 

C 

D 


Male 4 Pin 

Function 

Sensor Signal 
Sensor Signal 
+10V Power 
Ground 


Robot End: 

Pin# 


Female 4 Pin 

Function 

Sensor Signal 
Sensor Signal 
+1QV Power 
Ground 
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Shoulder Joint Position Encoder Cable (1) 


Purpose: 
Wire used: 
Notes: 


Take signal from extra encoder on shoulder to computer 
Low impedance cable with three twisted shielded pairs 
Shield wires ground to connector housing on computer end 


Pinouts: 

Computer End: _Male DB-15 


Pin # 

Function 

1 

A/D Low 

2 

A/D Ground 

3 

N.C 

4 

N.C 

5 

Encoder +5 V 

6 

Encoder Index 

7 

Encoder B 

8 

Encoder A 

9 

A/D High 

10 

Digital I/O Ground 

11 

N.C. 

12 

Encoder Ground 

13 

Not Used 

14 

Not Used 

15 

Not Used 


Robot End: Female DB-9 


Pin # 

Function 

Encoder 

Wire 

Color 

1 

Encoder Index 

Orange 

2 

Encoder B 

White 

3 

Encoder Ground 

Black 

4 

N.C 

N.A. 

5 

Encoder A 

Blue 

6 

Encoder +5 V 

Red 

7 

N.C 

N.A. 

8 

N.C 

N.A. 

9 

N.C 

N.A. 
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C.2 Junction Boxes 

There are two junction boxes mounted on the side of the robot base: the electronics 
box and the motor box. They serve to re-route signals from the racks into those for the 
robot. The motor box handles motor power and the limit switches and the electronics box 
handles all other signals (except the extra shoulder encoder, which goes directly from the 
computer rack to the robot). The electronics box also houses three small wire wrapped 
boards which are used to amplify and filter the strain gage signals from the torque sensor. 
Figure C. 1 shows a layout of the amplifier box. 


Back 



Front 

Figure C.l Layout of the Electronics Box 

Figure C.2 and C.3 show the layout of the front and back of the box where the cables 
plug in. Those coming from the racks plug into the front (the left side when it is mounted) 
and those going to the robot plug into the back (the right side when it is mounted). 
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JVIalcDB45_ 

Shoulder 

(000 00 000) 
\o o o o o o 0/ 

Elbow 

(000 00 000) 
\o o o o o o 0/ 

Wrist 

(000 00 000) 
\o OOOOO 0/ 


Torque Sensor 
Power Cable 


© 

Male 7 Pin 

Male 5 Pin 


Encoder/Tach Cables Limit Switch Jumper A/D Cables 
(To Computer Rack) Cable (To Motor Box) (To Computer Rack) 


Bottom 



(To Amplifier Rack) /shoulder & Elbow) 

/o~o\ i' - _ _ I 


VO o o o 


Wrist 

fo O O O ® 
\o 000/ 


Figure C.2 Front of the Electronics Box 



Fi gure C.3 Back of the Electronics Box 

There are three terminal strips on the bottom of the box, one for each joint, which 
have the limit switch, encoder and tachometer signals running through them. Then there is 
one terminal strip mounted on the side of the box which routes the signals from the torque 
sensor signal conditioning cards. Figure C.4 and C.5 detail what each screw on the terminal 
strips is for. 
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( 

r 

i 


To Motor Box 
Limit Switch 
Limit Switch 
Encoder A 
Encoder B 


To_Robot_ 
Limit Switch 
Limit Switch 
Encoder A 
) 4 ( Encoder B 


Y» Q 1 Limit 

) 2 ( Limit 


Encoder I Encoder I 

Whedco +5V Encoder Power (+5V) 

Whedco Ground -j-* t ) 7 ( ) *j- Encoder Ground 
A/D Ground y* { ) 8 C > *f- N.C. * 


A/D High 

,_A/D Low 

To Computer 


t* p9Q «!- Tach 
* MOl<)C> ^ Tach 


Encoder/Tach/Limit Switch 
Terminal Strips 




J 


Eigure C.4 Wiring for Encoder, Tachometer and Limit Switch Terminal Strips 

[Note: There are few additions to this terminal strip. ’’Pull-up" resistors (2200Q) arc 
located between encoder A, B, I and +5 V to allow the encoder signal to travel back to the 
Whedco Boards. Also, there is a voltage divider on the tach signal to keep it in the ±2.5 V 
range which the D/A is set on. This circuit consists of a 75kQ resistor between the tach 
signal and the A/D high and then a 20kH resistor between the A/D high and A/D low. 

Finally, there is a 20kQ resistor connecting A/D low to A/D ground to keep the low close to 
zero volts.] 


104 





Appendix C: Wiring Details 


To Signal Conditioner Cards 

/ Shoulder Torque Sensor Signal ) 1 T 3-f 

j Elbow Torque Sensor Signal -j-» ( ) 2 la-t- 

| Wrist Torque Sensor Signal 

| Torque Sensor Ground (All Joints) 

| Circuit Power (+15 V) 

\ Circuit Power (-15V) 

>-< __ 

( A/D Low (All Joints) y» f£ ) 7 T 

To Computer 




£ 


75oon 




To Computer 
A/D High (Channel 8) 
A/D High (Channel 9) 

) 3 C A/D High (Channel 10)/ 
Power Supply Ground > 




irq -r 






ns: 


N.C. 
N.C. 
N.C. 




I 


Power Supply +15V I 
Power Supply -15 V I 
Power Supply Ground ^ 
Power Supply Ground ) 
A/D Ground* < ~ ) 
N.C ToWrist 
N.C. Encoder/Tach/ 
N,C, Limit Switch 
Terminal Strip 


To Torque Sensor 
Power Supply 
(Amp Rack) 


Torque Sensor 
Terminal Strip 


Figure C.5 Wiring for Torque Sensor Terminal Strip 

[♦Note: The A/D ground is connected to the A/D ground on the wrist encoder/tach/limit 
switch terminal strip since the A/D cables did not carry the A/D ground signals from the 
computer.] 


Figure C.6 details the wiring of the torque sensor signal conditioning boards. There 
are two potentiometers in this circuit, one (blue 100Q) allows adjustment of the gain 
according to formula C. 1 and the other (yellow 50kO) allows adjustment of the output offset 
so the sensor can be zeroed out at no torque. [IMPORTANT: Changing the gain on the 
board will require re-calibration of the torque sensors.] Also, there are two capacitors 
(located behind the power conditioning capacitors, right next to the chip) which set the filter 
cut-off frequency. It is nominally at 1kHz, but we have set it to 100Hz. Formulae C.2 and 
C.3 give the capacitor values for a given bandwidth. 


r ■> ^ . 80kQ 

c = 2 +— 


(C.l) 


In this formula G is the gain and R is the total resistance between pins 3 and 4. (Note: the 

160 resistor in series with the potentiometer must be added to the potentiometer resistance to 
use this formula.) 
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1 = 0.015HF 
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C^l = 0 . 00224 F I 


1kHz 

f. 


-1 


J 


1kHz 

f 


-1 


J 


(C.2) 


(C.3) 


In these formulae f c is the desired cut-off frequency (in kHz). 
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Appendix C: Wiring Details 


COMM -15V +15V 



Figure C.6 Wiring for Torque Sensor Signal Conditioning Board 

The motor box is pretty much self-explanatory. The motor power and limit switch 
come in from the amplifier rack, and the limit switch signals are routed out the front to the 
electronics box. The motor power and shield run out the back of the box through the white 
cables to the motors. 
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Appendix D: Motor/Drive Spread Sheet 


This appendix contains a copy of the spreadsheet used to select the motor and 
Harmonic Drive for each joint. As you can see several motors were selected for each joint 
and then their combination with different Harmonic Drives was evaluated. To do this, first 
all the important motor data was entered (torque and speed data). The first set of motors are 
selections for the wrist, the second set for the elbow and the third for the shoulder. Then, the 
Harmonic drive data was entered (columns 9 & 11,24 & 26) for two different drive 
selections. Finally, two different sets of link lengths were entered for each drive. 

Next, the formulas for the various other quantities were entered. The Max. Speed 
and Max. Torque columns are how fast the output turns with that row's motor and that 
column's Harmonic Drive. The columns with TqJl, TqJ2 and TqJ3 represent the torque that 
the other joints would need to produce if the robot were driving its tip into a rigid obstacle, 
based on the link length at the top of that column. Finally, there are two columns which 
determine the endpoint force and speed that could be developed (with the other joints locked). 

This format allowed us to try several different drives and link length combinations to 
determine which ones would fit well with a particular set of motors. This was a convenient 
method because we could just change the drive reduction or link length and then evaluate its 
effect on the system. The goal was to get a set of motors, drives and link lengths that would 
be comparable, so no joint was significantly stronger or weaker than the others. The final 
motor selections we made are indicated by an asterisk (*), the Harmonic Drives we selected 
are in columns 24 & 26, and the link lengths were 12", 12" and 4". 
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Appendix D: Motor/Drive Spread Sheet 
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Appendix D: Motor/Drive Spread Sheet 
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Appendix D: Motor/Drive Spread Sheet 
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